Anadi lo que viene siendo la fuerza armonica angular, el cual, como siempre tuve problemas, parace que no funciona del todo bien, pero al imprimir el angulo entre las particulas, esta si logra mantenerse oscilando entre el angulo deseado, el angulo con el que probe fue de 160 grados, considero que otro valor mas grande lo unico que lograra sera que explote la simulacion, al menos que agregue una constante mas pequena.
En esta version, intente meter algunas funciones dentro de otros archivos y hacer un poco mas legible y no tener todo en un solo archivo, ademas se implemento el sistema sobre amortiguado que luce algo asi.
An un angulo de 90 grados.